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A bstra ct 

The ability of a autonomous space robot to grasp a 
freely translating and rotating object is being tested in 
the simulated microgravity environment aboard a KC135 
airplane. The Extravehicular Activity Helper/Retriever’s 
(EVAHR’s) arm trajectory planner continually requires a 
current estimate of the target's translational and rotational 
state. The target’s attitude, angular velocity and angular 
acceleration define its rotational state and the target’s 
translational state include its position, velocity and 
acceleration. Estimators have been developed based on 
the extended Kalman filter (EKF) algorithm. The 
KC135 microgravity environment does not have a 
convenient inertial reference frame for the translational 
dynamics and therefore, the translational as well as the 
rotational object dynamics are described by nonlinear 
equations. The estimator algorithms require intensive 
mathematical computation and therefore, I860 
microprocessors are used so that the software will run in 
real time. Estimator design, implementation concerns 
and issues specific to the KC135 environment are 
discussed. Translational state estimator performance 
results from simulation testing and from real-time 
integrated system testing are presented. 

KC135 Experiment 

One of the objectives of the Automation and 
Robotics Department at the Johnson Space Center is to 
design and develop a free-flying autonomous space robot. 
The immediate goal of the EVAHR project is to have the 
EVAHR grasp a freely translating and rotating object in 
a microgravity environment. This environment is 
simulated in the cabin of a KC135 airplane by having 
the plane fly along a parabolic trajectory. Sections of 
the robot that are necessary for the experiment are bolted 
to the KC135 cabin floor or are secured in some other 
fashion. Included are a Robotics Research arm, an 
inertial measurement unit (IMU), a vision system, 
release mechanism, cages containing the I860 processors 
and other computer equipment. There are two candidate 
vision systems: PRISM3 0) and the Perception scanner 
(2). The PRISM3 position measurement rate is 20-30 
Hz and the position measurement rate of Perceptron 
scanner is 5 - 8 Hz. 

KC135 Environment 


The gravitational forces experienced in the cabin of 

the KC135 change from above 1.5 g (1 g = 32.2 ft/s^) 
during "pull-up" to less than 50 mg of microgravity in 
approximately 7 seconds. The microgravity 
environment (less than 100 mg) lasts approximately 
20 seconds; however, the microgravity period during 
which the target is relatively stationary in the Robotics 
Research arm’s work space usually ranges from 0 to 10 
seconds per parabola. This decrease is caused by the 
fluctuations of up to 100 mg in the gravitational 
acceleration during the microgravity portion of the 
parabola. These undesired microgravity fluctuations 
cause the relatively stationary floating target to fly 
against the ceiling or floor of the airplane. 

Another characteristic of the KC135 environment is 
the usual initial fluctuation in the vertical acceleration 
as the airplane enters the microgravity portion of the 
flight. This is illustrated in Fig. 1. To avoid premature 
target release and the resulting undesired target dynamics, 
a release indicator mechanism was developed. The 
vertical acceleration, the pitch rate, and the pitch 
acceleration are monitored to determine the proper time 
to release the target. These measurements are taken 
from accelerometers and 3-axis gyroscopes. The 
microgravity portions of the flight that experience 
minimal pitch acceleration tend to be the better quality 
parabolas. 


Microgravity Vertical Acceleration 
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Fig. 1 


Copyright c 1993 by the American Institute of Aeronautics and Astronautics, Inc. No copy is asserted in the United States 
under Title 17, U.S. Code. The U.S. Government has a royalty-free license to exercise all rights under the copyright claimed 
herein for government purposes. All other rights are reserved by the copyright owner. 



Relative Translational Dynamics 


( 2 ) 


The KC135 cabin environment and the EVAHR 
instrumentation do not provide a practical inertial 
reference frame which can be utilized in modelling the 
target’s translational dynamics. The EVAHR 
translational estimator coordinate frame, which is a 
Cartesian coordinate system centered at a comer of the 
IMU plate, is essentially an accelerating reference frame. 
At present, the EVAHR hardware does not include a 
sensor that gives position expressed in an earth reference 
frame (differential GPS etc.). Double integrating the 
output of the accelerometers for 1 - 2 hours without 
another correcting measurement is undesirable. EVAHR 
instrumentation does provide enough information to 
calculate the target ’s acceleration relative to the robot. 
There are several implicit assumptions in determining 
the relative acceleration. One is that the EVAHR's and 
target’s gravitational accelerations are equal in magnitude. 
It is also assumed that the only force acting on target is 
gravity and third, the atmospheric drag acting on the 
target is zero. The relative acceleration of the target with 
respect to the EVAHR is given by 
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where 

E (d £ is the EVAHR’s angular velocity (filtered 
gyro reading) 

E a £ is the EVAHR's angular acceleration 
E a E is the EVAHR’s translational acceleration 
(filtered accelerometer reading) 

E r T is the target's position relative to EVAHR 

e v t is the target’s velocity relative to EVAHR 
E a T is the target's acceleration relative to EVAHR. 
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where 

E apastj is the target's relative acceleration 
during the last iteration 
E vpastj is the target’s relative velocity 
during the last iteration 
E rpastrp is the target’s relative position 
during the last iteration 
At is length of iteration interval. 

(iii) recompute E a T based on updated E v T and 
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(iv) recompute (ii) based on updated E ap 

KC135 Translational EKF Filter Design 

The EKF system model for the KC135 translational 
state estimator may be expressed as 

— « f(x(t)) +w(t) (4) 

and the measurement model may be expressed as 

z k = H x(t k ) + v k (5) 

where 

x(t) is the state vector 

w(t) is a zero mean white process 

v k is a zero mean white sequence. 

For the EKF algorithm, the state may be written as 

x(t) = x*(t) + Ax(t) (6) 


For computational reasons, during each calculation 
time period (iteration) the acceleration is determined 
twice. The first calculation uses the target's position and 
velocity estimates from the previous iteration. Next, the 
position and velocity estimates are updated using the new 
relative acceleration. The acceleration is then again 
determined using the updated position and velocity 
estimates. The relative velocity and relative position are 
determined in each iteration as follows 

(i) compute the relative acceleration, a T , based on 
the target’s velocity and position estimates of the 
previous iteration 


where 

x*(t) is an estimate of the state. 

Combining equations (4) and (6), and expanding to the 
first order. 

Therefore, the linearized model maybe expressed as 


(ii) compute 


dAx(t) bf(x(t)) . 
dt &x *(t) = x*(t) 
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The state matrix calculation is determined by 

«'<Wk>- I + F4 ‘ (9) 


where 

*“ $ x 'x(tk) = X* (tk) 

At is the time interval between l k and t k+1 


This calculation is extended out to the second order. 
Accuracy requirements had to be balanced against 
computer computation time requirements in this 
determination. The Kalman filter process noise 
covariance matrix, Q(t k+1 ), is computed according to 


x 


p - 3 target position components 
v - 3 target velocity components 
co e -3 EVAHR gyro errors 

a e - 3 EVAHR angular acc. errors 
3 EVAHR accelerometer errors, 


(15) 


The IMU readings and the target's position and 
velocity estimates, all of which have some error, must 
be used to determine the target's acceleration, which is 
given by equation (1). Now the measured angular 
velocity and the EVAHR angular acceleration can be 
written as 

a)=© t + 8© (16) 
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+ Q(t k ) (10) 

where 

a is a sparse matrix whose nonzero elements are 
associated with the variances of the white Gaussian 
noise of equation (20). 

The Kalman filter error covariance matrix is propagated 
according to 


where 

0) is the vector of filtered EVAHR gyro readings 
co t is the vector of true EVAHR angular velocities 
8 co is the gyro error vector, 
a is the vector of computed EVAHR angular 
accelerations 

a t is the vector of true EVAHR angular accelerations 
8 a is the angular acceleration error vector. 

Similarly, the EVAHR acceleration may be written as 


+ Q(t k+1 ) (ii) 

The state, x(t k +), is revised by the filter according to 
x(t k +) = x(t k -) + K(t k ) [z(t k ) - Hx(t k -) ] (12) 

and the Kalman gain is given by 

K(t k ) = P(t k -)H T [HP(t k -)H T + R]- 1 (13) 

where 

R is the position measurement error covariance 
matrix. 

Also, the Kalman filter error covariance is updated by 
P(t k +) = [I - K(t k )H]P(t k -) (14) 

The state vector specific to the relative translational 
state estimator is defined as follows: 


5*2 — a 2t ^ a 2 (18) 

where 

a 2 is the vector of filtered EVAHR accelerometer 
readings 

a 2l is the vector of true EVAHR accelerations 
8a 2 is the accelerometer error vector. 

To form the state matrix, the time derivative of the 
target’s velocity error is expressed as 


~^= A8p + B8v + C8co + D8a - 8a 2 
where 


A = 


2 2 
0)| +co 2 

-C0qC 0 j-a 2 

-a) 0 o) 2 +a 1 


-co 1 co 0 +a 2 

2 2 
w 2 +co 0 

-co 1 a) 2 -a 0 


-a^coQ-aj 

-(D 2 (D |+ot 2 

2 2 
(O 0 +(0j 


(19) 


746 



0 

2t0 2 

-2(0 j 

B = 

-2to 2 

0 

20) 0 


2o)j 

-2o) 0 

0 


‘ a ll 

an 

a 31 

C = 

a 12 

a 22 

a 32 


- a 13 

323 

— 1 

m 

cP 


v is the estimate of the target’s velocity relative to 
the EVAHR 

^ v= v true ' v 

P j a 3x3 diagonal matrix with the value p j 
P 2 is a 3x3 diagonal matrix with the value P 2 
nj is the white Gaussian noise vector whose 
value is determined from gyro noise tests 
and from system testing 
n 2 is the white Gaussian noise vector whose 

value is determined from accelerometer noise 
tests and from system testing 
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Therefore, the particular EKF system model is given by 
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Equation (20) has the same form as equation (8). 

Rotational State Estimator 

The rotational state estimator uses quaternions to 
describe the target's attitude and utilizes an EKF 
algorithm (3) . For further information on quaternion 
estimation refer to Bar-Itzhack's work ( 4 ). Bierman’s U- 
D factorization (5) technique was implemented to test for 
improved performance. An initial difference in 
performance was noted between the conventional EKF 
and the U-D factorization algorithm. However, after 
convergence, there was not a marked difference in 
performance. 

The essential difference between the rotational state 
estimator intended for the earth orbit scenario and the 
KC135 rotational state estimator is the definition of the 
inertial reference frame. For the KC135, the inertial 
reference frame for the target's attitude will be the 
EVAHR's coordinate frame when the microgravity 
portion of each parabola commences (t=0). The 
EVAHR's attitude will be determined by integrating the 
output of the gyros from the commencement time (t=0). 

Results 

The performance results shown in Fig. 2 are the 
product of a simulation test. A program was developed 
that simulates the dynamics of KC135 airplane, the IMU 
sensor readings, and the dynamics of the target. The 
added noise is white Gaussian noise. The Euclidian norm 
error of the position vector estimate and of the position 
vector measurement are shown. 


where 

p is the estimate of the target’s position relative to 
the EVAHR 


5 P= Ptrue ‘ P 
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Simulation Test Results 
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Fig. 2 


Testing of the Perception scanner is ongoing and 
calibration of PRISM3 vision system is in process at the 
writing of this paper. Results shown in Fig. 3 are 
preliminary. For this test the target was stationary and 
Fig. 3 shows the target's x-position estimate as well as 
the x-position measurement. Once calibration is 
complete, the values of measurement error covariance 
matrix R of equation (14) will be modified. 


Real-Time Test Results 



Time in Seconds 

Fig. 3 

Implementation Issues 

For the arm trajectory planner software to be able to 
receive the target's state at the rate of 100 Hz, the relative 
translational state estimator had to be divided into a 
repropagation unit and real-time propagation unit. The 


repropagation unit accepts dated position measurement 
inputs, compares the measurement to the appropriate 
archived state, revises the state, and then repropagates the 
state to present time. The updated state is passed to the 
real-time propagation unit. This module replaces its 
target state and Kalman filter parameters with the new 
updated state and new Kalman filter parameters. The 
real-time propagation unit continues to propagate the 
state and appropriate Kalman filter parameters while the 
repropagation unit has accepted another dated position 
measurement and is revising another archived estimate. 
The architecture is shown below in Fig. 4. 

The estimators are implemented on Mercury I860 
processors because of their fast computation capability. 
Closed form solutions were used where possible and 
matrix computation decreased by taking advantage of 
sparse matrices. 

A sensor bias test is performed just prior to the start 
of the flight, and these values are used to correct the 
IMU readings. The expected IMU drift during the flight 
was determined by running drift tests for a length of 
time comparable to flight duration, (1-2 hr). The 
sensor outputs are also passed through hardware and 
software filters before the readings are fed into the 
estimator at the rate of 100 Hz. 

Summary 

The design and performance of the KC135 
translational state estimator were discussed. Also 
presented were issues specific to the KC135 microgravity 
environment. 
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